package com.sky.utils;

import java.math.BigDecimal;

public class DistanceUtil {

    //平均半径,单位：m；不是赤道半径。赤道为6378左右
    private static final double EARTH_RADIUS = 6371000;

    public static BigDecimal getDistanceBigDecimalOneDecimalPlace(BigDecimal lat1, BigDecimal lng1, BigDecimal lat2, BigDecimal lng2) {
        return getDistanceBigDecimal(lat1, lng1, lat2, lng2).setScale(1, BigDecimal.ROUND_HALF_UP);
    }

    public static BigDecimal getDistanceBigDecimal(BigDecimal lat1, BigDecimal lng1, BigDecimal lat2, BigDecimal lng2) {
        //经纬度（角度）转弧度。弧度用作参数，以调用Math.cos和Math.sin
        //A经弧度
        BigDecimal radiansAX = new BigDecimal(Math.toRadians(lng1.doubleValue()));
        //A纬弧度
        BigDecimal radiansAY = new BigDecimal(Math.toRadians(lat1.doubleValue()));
        //B经弧度
        BigDecimal radiansBX = new BigDecimal(Math.toRadians(lng2.doubleValue()));
        //B纬弧度
        BigDecimal radiansBY = new BigDecimal(Math.toRadians(lat2.doubleValue()));
        //公式中“cosβ1cosβ2cos（α1-α2）+sinβ1sinβ2”的部分，得到∠AOB的cos值
        BigDecimal cos =  new BigDecimal(Math.cos(radiansAY.doubleValue()) * Math.cos(radiansBY.doubleValue()) * Math.cos(radiansAX.doubleValue() - radiansBX.doubleValue())
                + Math.sin(radiansAY.doubleValue()) * Math.sin(radiansBY.doubleValue()));
        //反余弦值
        BigDecimal acos = new BigDecimal(Math.acos(cos.doubleValue()));
        //最终结果
        return new BigDecimal(EARTH_RADIUS).multiply(acos);
    }

    public static double getDistanceDouble(Double lat1, Double lng1, Double lat2, Double lng2) {
        //经纬度（角度）转弧度。弧度用作参数，以调用Math.cos和Math.sin
        //A经弧度
        double radiansAX = Math.toRadians(lng1);
        //A纬弧度
        double radiansAY = Math.toRadians(lat1);
        //B经弧度
        double radiansBX = Math.toRadians(lng2);
        //B纬弧度
        double radiansBY = Math.toRadians(lat2);
        //公式中“cosβ1cosβ2cos（α1-α2）+sinβ1sinβ2”的部分，得到∠AOB的cos值
        double cos = Math.cos(radiansAY) * Math.cos(radiansBY) * Math.cos(radiansAX - radiansBX) + Math.sin(radiansAY) * Math.sin(radiansBY);
        //反余弦值
        double acos = Math.acos(cos);
        //最终结果
        return EARTH_RADIUS * acos;
    }

    public static double getDistanceDouble(BaiduUtil.GeoPoint p1, BaiduUtil.GeoPoint p2){
        return getDistanceDouble(p1.getLat(), p1.getLng(), p2.getLat(), p2.getLng());
    }

    public static void main(String[] args) {
        //(lat=36.67782920593408, lng=117.0878319231673)
        //(lat=40.05682848596073, lng=116.3076223267197)
        System.out.println(getDistanceDouble(36.67782920593408, 117.0878319231673,40.05682848596073, 116.3076223267197));
    }
}